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Abstract 

The  goal  of  this  research  is  to  achieve  close  to  real-time  dynamics  performance  for  allowing  the  closed- 
loop  testing  of  unmanned  ground  vehicles  (UGV)  for  urban  as  well  as  off-road  scenarios.  The  over¬ 
all  vehicle  dynamics  performance  is  governed  by  the  multibody  dynamics  model  for  the  vehicle,  the 
wheel/terrain  interaction  dynamics  and  the  onboard  control  system.  The  topic  of  this  paper  is  the  de¬ 
velopment  of  computationally  efficient  and  accurate  dynamics  model  for  ground  vehicles  with  complex 
suspension  dynamics. 

In  this  paper,  we  describe  the  multibody  dynamics  modeling  approach  for  our  reference  4-wheeled  vehi¬ 
cle,  which  has  a  double  wishbone  suspension  and  associated  spring-damper  unit  at  each  wheel  (Eigure  1). 
Each  of  these  wheel  suspensions  contains  a  number  of  artic¬ 
ulated  bodies  with  multiple  kinematic  closed  loops.  Despite 
the  large  number  of  internal  degrees  of  freedom,  due  to  the 
constraints,  each  suspension  has  only  a  single  effective  de¬ 
gree  of  freedom. 

The  standard  approach  for  modeling  closed-chain  system 
dynamics  [1]  entails  decomposing  the  system  into  a  tree- 
topology  system  (or  even  a  collection  of  independent  bod¬ 
ies)  and  appending  the  closed-chain  bilateral  constraints  to 
the  equations  of  motion.  A  drawback  of  this  approach  is  the 
increased  computation  for  solving  the  equations  of  motion. 

Another  serious  drawback  is  the  error  drift  that  arises  dur¬ 
ing  the  integration  of  the  multibody  dynamics  equations  of 
motion.  This  error  drift  is  usually  handled  by  the  use  of  a 
differential-algebraic  equation  (DAE)  solver  and  error  cor-  Eigure  1:  The  double  wishbone  suspen- 
rection  algorithms  to  manage  the  constraint  error  over  time,  sion  for  a  single  wheel, 
adding  even  more  computational  cost  and  accuracy  error  to 

the  dynamics  solution.  Our  real-time  performance  needs  require  us  to  address  these  major  computational 
drawbacks  of  the  conventional  approaches  for  closed-chain  dynamics. 

The  recently  developed  constrained  embedding  (CE)  method  [2,  3]  overcomes  these  key  drawbacks  for 
closed-chain  dynamics  models.  In  this  paper  we  describe  the  specific  constraint  embedding  approach  we 
have  used  for  the  multibody  modeling  of  the  vehicle  and  suspension  dynamics.  The  constraint  embed¬ 
ded  technique  converts  all  constraint  loops  into  variable  configuration  compound  bodies  which  have  the 
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same  number  of  degrees  of  freedom  as  the  number  of  independent  degrees  of  freedom  for  the  loops  they 
replaee.  These  eompound  bodies  loeally  handle  their  internal  degrees  of  freedom  and  eonstraint,  effee- 
tively  hiding  them  from  the  dynamies  solver.  The  resulting  system  topology  is  onee  again  a  tree  with 
only  inter-body  hinges  and  no  bilateral  eonstraints.  The  benefit  of  this  approaeh  is  that  the  strueture- 
based  0(N)  tree  algorithms  ean  be  direetly  used  to  solve  the  dynamies,  and  this  formulation  results  in 
an  ODE  instead  of  a  DAE.  Thus  extra  error  eontrol  teehniques  are  not  needed.  This  method  however  is 
more  eomplex  to  implement,  sinee  the  aggregated  bodies  now  have  eonfiguration  dependent  geometry. 

While  CE  method  shares  the  minimal  eoordinates  attribute  with  projeetion  dynamies  teehniques  [1,  4], 
its  advantage  lies  in  the  preservation  of  the  system’s  tree  topology  that  is  neeessary  for  the  use  of  the 
strueture-based  tree  algorithms. 

In  this  paper  we  deseribe  the  CE  modeling  approaeh  for  the  individual  wheel  suspensions,  the  overall 
vehiele  dynamies  model,  and  the  adaptation  of  the  reeursive  0(N)  dynamics  algorithm  for  efficiently 
solving  the  equations  of  motion.  While  generic  iterative  methods  can  be  used  to  solve  the  kinematics 
for  the  loops,  we  describe  methods  to  increase  the  efficiency  using  analytical  fechniques.  We  describe 
fhe  significanf  performance  speed  up  and  accuracy  fhaf  we  obfain  compared  wifh  fhe  convenfional  DAE 
approaches. 
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